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[57] ABSTRACT 

Model-based and performance-based control techniques 
are combined for an electrical robotic control system. 
Thus, two distinct and separate design philosophies 
have been merged into a single control system having a 
control law formulation including two distinct and sep- 
arate components, each of which yields a respective 
signal component that is combined into a total com- 
mand signal for the system. Those two separate system 
components include a feedforward controller and a 
feedback’ controller. The feedforward controller is 
model-based and contains any known part of the manip- 
ulator dynamics that can be used for on-line control to 
produce a nominal feedforward component of the sys- 
tem’s control signal. The- feedback controller is perfor- 
mance-based and consists of a simple adaptive PID 
controller which generates an adaptive control signal to 
complement the nominal feedforward signal. 

19 Claims, 14 Drawing Sheets 
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FIG. I0i 
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ROBUST HIGH-PERFORMANCE CONTROL FOR 
ROBOTIC MANIPULATORS 

BACKGROUND OF THE INVENTION 5 

1. Origin of the Invention 

The invention described herein was made in the per- 
formance of the work under a NASA Contract and is 
subject to the provisions of Public Law 96517 (35 USC 
202) in which the contractor has elected not to retain 10 
title. 

2. Field of the Invention 

This invention relates to control systems for control- 
ling robotic manipulators. 

3. Description of the Prior Art 15 

The next generation of robotic manipulators will 

perform high-precision tasks in partially unknown and 
unstructure environments. These tasks require precise 
motion control of the manipulator under unknown and 
varying payloads. These requirements are far beyond 20 
the capabilities of present-day industrial robot control- 
lers, and demand robust high-performance manipulator 
control systems. The need for advanced manipulator 
control systems to accomplish accurate trajectory 
tracking has therefore been recognized for some time, 25 
and two parallel lines of research have been pursued. 
The primary outcome of such research is the develop- 
ment of two classes of advanced manipulator control 
schemes, namely model-based and performance-based 
techniques. ' 30 

Model-based techniques, such as the Computed 
Torque Method by B. R. Markiewicz: Analysis Of The • 
Computed Torque Drive Method And Comparison With 
Conventional Position Servo For A Computer-Controlled 
Manipulator, Technical Memorandum 33-601, Jet Pro- 35 
pulsion Laboratory, 1973, are based on cancellation of 
the nonlinear terms in the manipulator dynamic model 
by the controller. This cancellation is contingent on two 
assumptions which are not often readily’met in practice. 
First, the values of all parameters appearing in the ma- 40 
nipulator dynamic model, such as payload mass and 
friction coefficients, must be known accurately. Sec- 
ond, the full dynamic model of the manipulator needs to 
be known and computed on-line in real-time at the 
servo control rate. Performance-based techniques, such 45 
as the direct adaptive control method by S. Dubowsky 
and D. T. DesForges: The Application Of Model- 
Referenced Adaptive Control To Robotic Manipulators, 
ASME Journal of Dynamic Systems, Measurement and 
Control, Vol. 101, pp. 193-200, 1979, attempt to over- 50 
come these limitations by adjusting the controller gains 
on-line in real-time, based on the tracking performance 
of the manipulator; and, thus, eliminating the need for 
the manipulator model. Therefore, the indentification of 
the manipulator and payload parameters of the complex 55 
manipulator dynamic model is not necessary,, and hence 
a fast adaptation can be achieved. Adaptive control 
methods, however, may become unstable for high adap- 
tation rates and treat the manipulator as a “black-box” 
by not utilizing any part of the manipulator dynamics in 60 
the control law formulation. 

During the past few years, several attempts have been 
made to combine the model-based and performance- 
based techniques in order to take full advantage of the 
merits of both techniques and overcome their limita- 65 
tions. For instance, in the approach of J. J. Craig, P. 
Hsu, and S. S. Sastry: Adaptive Control Of Mechanical 
Manipulators, Proc. IEEE Intern. Conf. on Robotics 
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and Automation, Vol, 1, pp. 190-195, San Francisco, 
1986, and R. H. Middleton and G. C. Goodwin: Adapt- 
ive Computed Torque Control For Rigid Link Manipula- 
tors, Proc. IEEE Conf. on Decision and Control, Vol. 1, 
pp. 68-73, Athens, 1986, the manipulator parameters are 
estimated adaptively first and are then utilized in a dy- 
namic-based control law. 

First attention is directed to Oswald U.S. Pat. No. 
4,200,827 which discloses a control system for a mag- 
netic head including both velocity and position feed- 
back and feedforward signals representing both veloc- 
ity and acceleration. See FIG. 1 and column 3, line 17 to 
column 6, line 35. Also, see Penkar et al. U.S. Pat. No. 
4,773,025 and Axelby U.S. Pat. No. 4,663,703. 

Next attention is directed to Takahashi U.S. Pat. No. 
4,639,652 which discloses a control system for a robot 
manipulator including adaptive position and velocity 
feedback gains. See gain adjuster 14 and gains 5 and 6 in 
FIG. 1. Particular attention should be given to the cir- 
cuit diagram presented in FIG. 4 of this reference 
which differs from FIG. 1 only in the use of the transfer 
function T(s) and operates in accordance with the de- 
scription beginning at column 4, line 48 through column 
6, line 29. This reference is of interest only because of 
the high speed positioning control. It relies upon a prior 
art technique commonly known as “Identification”, in 
that test runs permit the gains of its control law to be 
identified. 

Next attention is directed to Shigemasa U.S. Pat. No. 
4,719,561 which discloses a control system having ro- 
bust controller 24 in combination with a PID controller 
22 . See FIG. 3 and column 5, line 13. 

The following references all disclose a control system 
for a robot manipulator. 


Browder 

4,341,986 

Hafner 

4,546,426 

Horak 

4,547,858 

Perzley 

4,603,284 

Perreirra et al. 

4,763,276 

The following references are 

cited as of interest. 

Littman et al. 

3,758,762 

Hiroi et al. 

4,563,735 

Matsumura et al. 

4,670,843 

Shigemasa 

4,679,136 


In contrast to the Computed Torque Method of the 
prior art, the invention does not rely on an accurate 
dynamic model in order to control the manipulator. 
Furthermore, global asymptotic stability of the control 
system is assured since the feedback adaptation laws are 
derived from a Lyapunov analysis, and the feedforward 
controller is outside the servo control loop. 

A new, robust control system using a known part of 
the manipulator's dynamics in a freeforward control 
circuit and any unknown dynamics and uncertainties 
and/or variations in the manipulator/payload parame- 
ters is accounted for in an adaptive feedback control 
loop. 

SUMMARY OF THE INVENTION 

This invention discloses and claims a novel approach 
of combining model-based and performance-based con- 
trol techniques. Two distinct and separate design phi- 
losophies have been merged into one novel control 
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system. The invention’s control law formulation is com- 
prised of two distinct and separate components, each of 
which yields a respective signal component that is com- 
bined into a total command signal for the system. 

These two separate system components include a 5 
feedforward controller and a feedback controller. The 
feedforward controller is model-based and contains any 
known part of the manipulator dynamics that can be 
used for on-line control to produce a nominal feedfor- 
ward component of the system’s command signal. The 10 
feedback controller is performance-based and consists 
of a simple adaptive PID controller which generates an 
adaptive control signal to complement the nominal 
feedforward signal. The feedback adaptation laws are 
very simple, allowing a fast servo control loop imple- 15 
mentation. 


4 

FIG. 11 (if) is a figure depicting the variation of the 
position gain k p (t) in accordance with the invention; 

FIG. ll(//7) is a figure depicting the variation of the 
velocity gain k v .(t) in accordance with the invention; 

FIG. ll(/v) is a figure depicting the variation of the 
control torque T(t) in accordance with the invention; 

FIG. 12(0 is a figure depicting the desired [dashed] 
and actual [solid] waist angles with arm configuration 
charge in accordance with the invention; and 

FIG. 12(0) is a figure depicting the waist tracking- 
error with arm configuration change in accordance 
with the invention. 

DESCRIPTION OF THE PREFERRED 
EMBODIMENT 

1. Summary Of Presentation 


BRIEF SUMMARY OF THE FIGURES OF THE 
DRAWING 

20 

FIG. 1 is a figure depicting a schematic diagram of a 
typical actuator and link assembly in accordance with 
the invention; 

FIG. 2 is a figure depicting a feedforward/feedback 
tracking control scheme in accordance with the inven- ^ 
tion; 

FIG. 3 is a figure depicting a two-link planar manipu- 
lator in a vertical plane in accordance with the inven- 
tion; 

FIG. 4(0 is a figure depicting the desired [dashed] 3Q 
and actual [solid] trajectories of the joint angle #i(t) in 
accordance with the invention; 

FIG. 4(/7) is a figure depicting the desired [dashed] 
and actual [solid] trajectories of the joint angle #2(0 in 
accordance with the invention; 35 

FIG. 5(0 is a figure depicting the variation of the 
tracking — error e2(t) in accordance with the invention; 

FIG. 5(0) is a figure depicting the variation of the 
tracking — error ei(t) in accordance with the invention; 

FIG. 6(0 is a figure depicting the variation of the 
control torque Ti(t) in accordance with the invention; 

FIG. 6(h) is a figure depicting the variation of the 
control torque T2O) in accordance with the invention; 

FIG. 7(0 is a figure depicting the variations of the 
auxiliary signals f 1 (t) [solid] and f2(t) [dashed] in accor- 45 
dance with the invention; 

FIG. 7(0) is a figure depicting the variations of the 
position gains k^ l (t) [solid] and k^ 2 (t) [dashed] in accor- 
dance with the invention; 

FIG. 7(Oi) is a figure depicting the variations of the 50 
velocity gains k p *(t) [solid] and k v 2 (t) [dashed] in accor- 
dance with the invention; 

FIG. 8 is a figure depicting the functional diagram of 
the testbed facility in accordance with the invention; 

FIG.. 9(0 is a figure depicting the desired [dashed] 55 
and actual [solid] PUMA waist angles under adaptive 
controller in accordance with the invention; 

FIG. 9(n) is a figure depicting the waist tracking- 
error under adaptive controller in accordance with the 
invention; 60 

FIG. 10(0 is a figure depicting the desired [dashed] 
and actual [solid] PUMA waist angles under unimation 
controller in accordance with the invention; 

FIG. 10(h) is a figure depicting the waist tracking- 
error under unimation controller in accordance with 65 
the invention; 

FIG. 11(0 is a figure depicting the variation of the 
auxiliary signal f(t) in accordance with the invention; 


The presentation of the invention is structured as 
follows. In Section 2, the integrated dynamic model of 
a manipulator and actuator system is derived. The 
tracking control scheme is described fully in Section 3. 
In Section 4, the digital control implementation of the 
scheme is given. The issue of robustness is discussed in 
Section 5. The control scheme is applied in Section 6 to 
the model of a two-link arm, and extensive simulation 
results are given to support the method. In Section 7, 
the implementation of the proposed control scheme on 
a PUMA industrial robot is described and experimental 
results are presented to validate the improved perfor- 
mance of the invention. Section 8 discusses the results 
and concludes the presentation of the description of the 
invention. 

2. Integrated Dynamic Model of 
Manipulator-Plus-Actuator System 

Most papers on manipulator control neglect the dy- 
namics of joint actuators, and treat the joint torques as 
the driving signals. In this section, a realistic approach is 
taken by including the actuator dynamics and modeling 
the manipulator and actuators as an integrated system. 

In many industrial robots such as the Unimation 
PUMA, the links of the manipulator are driven by elec- 
tric actuators at the corresponding joints, and the dy- 
namics of the joint actuators must be taken into account. 
Note that although electric actuators are modeled here- 
inafter, the results are general since the form of dynamic 
equations for other types of actuators is essentially the 
same. 

Referring to FIG. 1, each actuator 100 may be con- 
sidered as comprising a link 101, driven by a gear 110 
that meshes with a motor-driven drive gear 125. Many 
such actuators are generally required for any given 
robotics application. A single actuator as a general case 
will be presented in this application for simplicity pur- 
poses. It should be understood that several actuators as 
needed are driven by the command signal as developed 
by the control system of this invention. 

Any typical actuator is basically a DC servomotor 
with a permanent magnet 130 to provide the motor field 
and the driving signal is a voltage or a current applied to 
the armature winding. In FIG. 1, a driving voltage 
identified simply as Vyis impressed across a pair of input 
terminals 140. The resistance and inductance shown in 
the FIG. simply represent the internal parameters typi- 
cally found in any actuator and such matters are well 
known in the art and require no further description. 
Since servomotors are inherently high-speed low- 
torque devices, the gear assembly 110,125 is often re- 



5,049,796 


quired to mechanically couple the armature shaft 126 to 
the robot link 110 in order to obtain speed reduction and 
torque magnification. 

Consider now the jth actuator 100 and suppose that 
the armature is voltage-driven, as shown in FIG. 1. This 
representation is general because in cases where the 
armature is current-driven using the current source i(t) 
with shunt resistance R c , the driving source can be 
replaced by the voltage source v(t) = R c i(t) with series 
resistance 


1 

R c 


the mechanical equation for the jth actuator can be 
expressed as (refer to K. Ogata, supra) 


d 2 fyt) 
' dt 1 


d<b£t) 

+ fj—dT~ + W = '/'> 


(4) 


Let us now denote the angular displacement of the jth 
robot joint by 0/t), where 


10 


Therefore, without loss of generality, we can assume 
that the driving source of the jth joint motor is always 
the voltage source v/t) with the internal resistance r y. 
This source produces the current i/t) in the armature 
circuit; and the electrical equation for the jth actuator 
can be written as 


+ £ tfji J J i l — Jjm + (ty ) 2 J jl 

fj “ fjm + ~ fjm + (Xj ) 1 fjl ' 


( 2 ) 


(3) 


where R/and Ly are the resistance and inductance of the 


jth armature winding, <J>/t) is the angular displacement 
of the jth armature shaft, and the term 


Kbj 


d6p) 

dt 


is due to the back-emf generated in the armature circuit. 
Let us now consider the mechanical equation of the 
actuator. Referring to the armature shaft, the “equiva- 
lent” moment of inertia and friction coefficient of the 
total load are given by K. Ogata: Modern Control Engi- 
neering, Prentice Hall Inc., N.J., 1970 


rp) = r/p) + Rjip) + Ljj- [;/()] + Kbjjp [*/')] 


(0 45 


where and {Jy,f//} are the moments of inertia 

and friction coefficients of the jth motor shaft and the 
jth robot link respectively, while N ) m and N fy are the 
numbers of gear teeth on the motor side and on the link 
side respectively, and 


Ni = 




'jm 

w 


< 1 


55 


is the gear ratio. Although it is assumed that there is one 
gear mesh between the motor and the link, the result 
can be extended to multi-mesh gear trains in a trivial 
manner. See K. Ogata: Modern Control Engineering, 60 
Prentice Hall Inc., N.J., 1970. Equations (2) and (3) 
indicate that, as seen by the motor shaft, the link inertia 
and friction are reduced by a factor of (N fy) 2 . Now, the 
torque r/t) generated by the jth servomotor is propor- 
tional to the armature current i/t); that is, r/t)=K fl //t), 65 
and will cause rotation of the armature shaft by <£/t). In 
addition, the armature will exert an “effective” torque 
T/t) on the jth robot link through the gear train. Thus, 


Bp)=N/S>p) 


(5) 


due to the gear train. Then, (1) and (4) can be written in 
terms of 0/t) as 


15 


dip) j 

v/0 * (rj + Rj)ip ) + Lj —£ — + K bj 


dOp) 


dt 


20 


rp) — K a jip ) — 4 


<V/ 


d 2 ep) 

dt 2 


fj dOp) 


Ni 


dt 


-w> 


(6) 


(7) 


Eliminating the armature current i/t) between (6) and 
(7), the dynamic model of the jth actuator can be de- 
scribed by the third order differential equation 


25 


f L pj 


(rj -f- Rj)Jj + Ljfj 

Y e J . 

L toft 

J rfP + L 

KajXj 

J dr- + 

30 r 

( r j + RjVj + 

1 

i 

|jfe 

1 — 
i 

L 

Raj^j 

J* T l 

L K °j J dt ^ 


( 8 ) 


35 


- <rj+Rj)Nj ~L _ 

- Kaj J j ~ Vj 


40 


Consequently, for an n-jointed robot, the n joint actua- 
tors as a whole can be represented by the (3n)th order 
vector differential equation 


AOt +B&{f)+CQ{t)+Dl\t)+ETXt)=V{t) 


(9) 


where V(t), 0(t) and T(t) are nX 1 vectors and the nXn 
diagonal matrices in (9) are defined by 


■ [ 4k } 

n _ f (Q + RpJj + L/j "I 

Bjt - L J 


Cji — 


[ 


i r + Rj)fj + KbjKgj 


} 


Dj, ~l Kaj J’ 


~ <n + ~| 

L Kaj J 


In a typical DC servomotor, the inductance of the ar- 
mature winding is in the order of tenths of millihenries, 
while its resistance is in the order of a few ohms. Refer 
to J. Y. S. Luh: Conventional Controller Design For In- 
dustrial Robots — A Tutorial, IEEE Trans. Systems, 
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Man and Cybernetics, SMC 13(3), pp. 298-316, 1983. 
Thus, the inductances Lycan safely be neglected (L/—0) 
and in this case the actuator model (9) reduces (2n)th 
order model 


G0{t)+C6{t)+ET{t)=V{t) 


( 10 ) 


where 


f Oy + m " 

Gjj ” L ■ KajNj J* 


8 


10 


the gear trains coupling the motor shafts to the robot 
links. As seen from (4), the “effective” driving torque 
on the jth link is reduced by a factor of Ny as seen by 
the jth joint actuator. In addition, from (2) and (3), 
the moments of inertia and friction coefficients of the 
jth link are also reduced by a factor of (Ny) 2 as seen by 
the motor shaft. This implies that the mechanical 
parameters of joint motors, namely the motor shaft 
inertia and friction, can have a significant effect on 
the overall system performance; particularly in ro- 
bots with large gear ratios such as PUMA 560 where 
Nyis typically, 1:100. 


It is seen that the approximation Ly~0 has resulted in 
A = D = 0, hence a decrease in the order of the model 
from 3n to 2n. 

Now that the joint actuators have been modeled, we 
shall consider the manipulator dynamics. In general, the 
dynamic model of an n-jointed manipulator which re- 
lates the nX 1 “effective” joint torque vector T(t) to the 
nX 1 joint angle vector 0(t) can be written as (See J. J. 
Craig: Robotics — Mechanics and Control Addison 

Wesley Publishing Company, Reading, Mass., 1986). 

M*(m. e)d+X*(m,0.e)=T (11) 

where m is the payload mass, M*(m,0) is the symmetric 
positive-definite nXn inertia matrix, N*(m,0,0) is the 
nX 1 vector representing the total torque due to Corio- 
lis and centrifugal term, gravity loading term, and fric- 
tional term. The elements of M* and N* are highly 
complex nonlinear functions which depend on the ma- 
nipulator configuration 0, the speed of the motion 0, 
and the payload mass m. On combining (10) and (11), 
we obtain the integrated dynamic model of the 
manipulator-plus-actuator system as 

M(m,e)e+N(m.e.e)=v 02) 


3. Tracking Control Scheme 

15 Given the integrated dynamic model of the manipula- 
tor-plus-actuator system as 

M(m,G)$+N(m,e*e)= V ( 13 ) 

20 The tracking control problem is to devise a control 
system which generates the appropriate armature volt- 
ages V(t) so as to ensure that the joint angles 0(t) follow 
any specified reference trajectories 0^(t) as closely as 
possible, where 0r(t) is an nX 1 vector. 

25 The intuitive solution to the tracking control problem 
is to employ the full dynamic model (13) in the control 
scheme in order to cancel out the nonlinear terms in 
(13). This approach is commonly known as the Com- 
puted Torque Technique (see B. R. Markiewicz, supra), 

30 and yields the control law 

v=M(m,h[er^K/d r ~S)^K p (d r -e)\+\(m,e,e) (U) 

where K P and K v are constant diagonal nXn position 

35 and velocity feedback gain matrices. This results in the 
error differential equation 

eU)+KAt)+Kpe(t )= 0 (15) 


where the terms in (12) are defined as 

\n m ,e)=G+EM*(m.ey, 

A i(m. e, 0) = C0 + EN*(m. 0. 0) 

Equation (12) represents a (2n)th order coupled, nonlin- 
ear system with the nX 1 input vector V(t) of the arma- 
ture voltages and the nX 1 output vector 0(t) of the joint 
angles. 

Although the manipulator dynamic model (11) and 
the integrated system model (12) are both of order (2n), 
it is important to note that the integrated model (12) is 
a more accurate representation of the system than the 
manipulator model (11), which does not include the 
actuator dynamics. This is due to the following consid- 
erations: 

(i) Electrical Parameters: The main contribution from 
the electrical part of the joint actuators to the inte- 
grated system dynamics is the back-emf term K^0(t) 
in (6). This term can have a significant effect on the 
robot performance when the speed of motion 0(t) is 
high. Note that the back-emf appears as an internal 
damping term, contributing to the coefficient of 0(t) 
in (12). The other electrical parameter is the armature 
resistance R which appears in (6) and converts the 
applied armature voltage v(t) to the current i(t) and in 
turn to the driving torque T(t). 

(ii) Mechanical Parameters. The major contribution 
from the mechanical part of the joint actuators to the 
robot performance is due to the gear ratios Ny[< 1] of 


40 where e(t) — 0r(t)~0(t) is the nXl vector of position 
tracking-errors. When the diagonal elements of K p and 
K v are positive, (15) is stable; implying that e(t)-k) or 
0(t)^0r(t) as t — ► oo , i.e. tracking is achieved. In the 
control law (14), we have implicitly made a few as- 
45 sumptions which are rarely true in practice. The major 
problem in implementing (14) is that the values of the 
parameters in the manipulator model (13) are often not 
known accurately. This is particularly true of the fric- 
tion term and the payload mass. Another problem in 
50 implementation of (14) is that the entire dynamic model 
(13) of the manipulator must be computed on-line in real 
time. These computations are quite involved, and the 
computer expense may make the scheme economically 
unfeasible. 

55 In an attempt to overcome the afore-mentioned limi- 
tations of the Computed Torque Technique, a new 
tracking control philosophy of the invention is pro- 
posed in this section. The underlying concept in this 
invention is that the full dynamic model is not required 
60 in order to achieve trajectory tracking and the lack of 
knowledge of full dynamics can readily be compensated 
for by the introduction of “adaptive elements” in the 
control system. Specifically, the proposed tracking con- 
trol system, FIG. 2, is composed of two components: 
65 the nominal feedforward controller 220 and the adapt- 
ive feedback controller 250. In FIG. 2, the block 235 
represents the manipulator plus actuators of the type 
generalized earlier herein. The output signals on leads 
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240 and 245 are the actual velocity and actual position 
of the system as sensed in any well known manner. 
Three separate input terms are depicted at leads 201, 
202, and 203. The signals on these input leads represent, 
respectively, desired position (cf> r ) on lead 201, desired 5 
velocity (<^ r ) on lead 202, and desired acceleration (<f> r ) 
on lead 203. The feedforward controller 220 contains 
computation elements 205 and 210. Computation ele- 
ments 205 and 210 take the known information that is 
available about the manipulator/system and compute, 10 
based upon the input signals at leads 201, 202, or 203 the 
available partial information that is fed to a summing 
junction 215. The output from summing junction 215 is 
a signal V 0 , which signal is in turn fed into another 
signal junction 230. The signal V 0 from junction 215 is 15 
the feedforward component of the total command sig- 
nal V that is developed by the invention at lead 232 into 
the manipulator plus actuators 235. Since the feedfor- 
ward loop 220 is model-based, any known information 
about the manipulators or the actuator system is input 20 
into the control loop. Data on the manipulator dynam- 
ics can be used for real-time control at the required 
sampling rate. Such information can be, for instance, 
only the gravity loading term or the manipulator full 
dynamics excluding the payload. The feedforward con- 25 
troller 220 is model-based and it acts on the desired joint 
trajectory 0X0 to produce the actuators driving voltage 

The role of the feedback controller 250 is to generate 
the corrective actuator voltage V a (t), based on the 30 
tracking-error e(t), that needs to be added to V 0 (t) to 
complement the feedforward controller. The feedback 
controller 250 is composed of adaptive position and 
velocity feedback terms and an auxiliary signal f(t). The 
feedback gains, KXO at element 240 and KXO element 35 
242 are varied in accordance with an adaptation law 
that is described in greater detail hereinafter. 

Suffice it to say at this point that the error terms and 
the desired terms for position and velocity are adapted 
to form an adaptation component, V a , at junction 230 40 
which is then combined with the feedforward compo- 
nent V 0 from loop 220 in order to yield the total com- 
mand signal for the control system of this invention. 
Thus, the feedback loop 250 employs these stated sig- 
nals which are updated continuously in real time to 45 
cope with the nonlinear nature of the system and uncer- 
tainties/variations in the manipulator parameters or 
payload. The feedforward and feedback controllers 
220, 250 are now discussed separately in Sections 3.1 
and 3.2. 

3.1 Nominal Feedforward Controller 

Suppose that some partial knowledge about the ma- 
nipulator dynamic model (13) is availabje in the form of 
“approximations” to, {M(m,0),N(m f 0,0)} denoted by 55 
{M o (m o ,0 r ),No(m o ,0 r ,0 r }, where m 0 is an estimate of m. 
Note that {M 0 ,N 0 } are functions of the reference trajec- 
tory 0X0 instead of the actual trajectory 0(t). The infor- 
mation available in M 0 and N 0 can vary widely depend- 
ing on the particular situation. For instance, we can 60 
have M o (m o ,0r) = O and N o (m o ,0 r) 0 r )=G(m,0 r )» where 
only gravity information is available. Likewise, it is 
possible to have M o (m o ,0 r ) = M(O,0 r ) and N 0 (- 
mo,0 n d r ) — N(0,6 r ,6r)> where no information about the 
payload is available. Furthermore, the matrices M 0 and 65 
N 0 may have either a “centralized” or a “decentralized” 
structure. In the centralized case, each element of M 0 
and N 0 can be a function of all joint variables. In the 


10 

“decentralized” case, [Mo]// and [No]/ are functions only 
of the ith joint variable and ]M o ]//=0 for ail i^j. 

The nominal feedforward controller is described by 

v 0 {t ) = Moim^rjOAt) + A Wmo. 0 r.Or) ( 1 6 ) 

where V 0 is the nXl nominal control voltage vector 
and the controller operates on the reference trajectory 
0X0 instead of the actual trajectory 0(t). It is important 
to realize that M 0 and N 0 are based solely on the infor- 
mation available on the manipulator dynamics which is 
used in the real-time control system of this invention. 
The controller matrices {M 0 , N 0 ) can therefore be 
largely different from the model matrices {M,N} due to 
lack of complete information, or due to computational 
constraints. For instance, in some cases we may wish to 
discard some elements of M and N in order to reduce 
the on-line computational burden, even if the full 
knowledge of manipulator dynamics is available. 

3.2 Adaptive Feedback Controller 

In contrast to the feedforward controller 220, FIG. 2, 
the feedback controller 250 does not assume any a priori 
knowledge of the dynamic model or parameter values 
of the manipulator plus actuators 235. This controller 
250 operates solely on the basis of the tracking perfor- 
mance of the manipulator through the tracking-error 
e(t). The controller 250 is adaptive and its gains are 
adjusted continuously in real-time by simple adaptation 
laws to ensure closed-loop stability and desired tracking 
performance. The on-line adaptation compensates for 
the changing dynamic characteristics of the manipula- 
tor due to variations in its configuration, speed, and 
payload. 

The adaptive feedback controller is described by 

Va( r) =A0 + K p (t)e(t) + K&fot) ( 1 7) 

where V a (t) is the nXl adaptive control voltage vec- 
tor, e(t) = 0Xt) — 0(t) is the nXl position tracking-error 
vector, f(t) is an nX 1 auxiliary signal generated by the 
adaptation scheme, and {K^(t),K v (t)} are the nXn ad- 
justable PD feedback gain matrices. The feedback con- 
trol law (17) can be either “centralized” or “decentral- 
ized.” For the centralized case, the controller adapta- 
tion laws are obtained as I have discussed in my paper 
entitled A New Approach to Adaptive Control of Manipu- 
lators, ASME Journal of Dynamic Systems, Measure- 
ment, and Control, Vol. 109, No. 3, pp. 193-202, 1987. 
For the decentralized control case, the gains 
{K^(t),KXt)> are diagonal matrices and their ith diago- 
nal elements are obtained from the adaptation laws 
(2 1)— (24) with e(t) replaced by e,<t). See, for further 
explanation my paper H. Seraji: Decentralized Adaptive 
Control of Manipulators: Theory, Simulation, and Experi- 
mentation, IEEE Journal of Robotics and Automation, 
1988, (to appear). The centralized case yields the con- 
troller adaptation laws as 


A*)=yv<t)+ytKt) 

( 18 ) 

Kp(t) = a\ [rd)e'( /)] + O2[K0^'(0] 

( 19 ) 

KM = 0 ! 4 . [*,)«,:(,)] + 0 2 [r(O <?'«] 

( 20 ) 
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where the prime denotes transposition, and r(t) is the 
n X 1 vector of “weighted” position-velocity error de- 
fined as 

*0=^0+ H'AO (21) 5 

In (1 8)— (2 1), {yi,ai,£i} are zero or positive propor- 
tional adaptation gains, {72,0^2, £2} are positive integral 
adaptation gains, and W /7 =diag/(w^/) and 
w v — diag,(w v /) are constant nXn matrices which con- 10 
tain the position and velocity weighting factors for all 
joints. Integrating ( 1 8)— (20) in the time interval [0,t], 
one obtains 

15 

At) -AO) = rilKh - * 0 )] + 72 f riOdt 

Kp(t) - K p { 0) = ax[Kt)e\t) - * 0)e'(0)] + a 2 f #P 20 

J 0 

/» / 

KM - Kji 0) = fa[At)e(t) - K0)e(0)] + fa «t)l\i)dt 

J 0 

25 

Since the initial values of the reference and actual tra- 
jectories are the same, we have e(0) = e(0) = r(0) = 0. 
This yields the Proportional = Integral (P = I) adapta- 
tion laws 


r t ( 26 ) 

V a (t) = A0) + K* p (t)e(t) + K* v * (t)e(t) 4- Kf e{t)dt 

j 0 

where 

K*p(t) = K p (t) 4-71 IVp + y 2 »V K*M=KM+y\ »V 
K*i=y2W p ( 27 ) 

It is seen that the feedback controller 250 as defined in 
accordance with equation (26) is composed of three 
terms which are effective during the initial, intermedi- 
ate, and final phases of motion: 

(i) The initial auxiliary signal f(0) can be chosen to over- 
come the stiction (static friction) and compensate for 
the initial gravity loading. This term improves the 
responses of the joint angles during the initial phase 
of motion. 

(ii) The adaptive-gain PD term K*^(t)e(t) + K*v(t)e(t) is 
responsible for the tracking performance during gross 
motion while the manipulator model is highly nonlin- 
ear; i.e., the changes of 0(t) and 0(t) are large. Each 
gain consists of a fixed part and an adaptive part. The 
online gain adaptation is necessary in order to com- 
pensate for the changing dynamics during the inter- 
mediate phase of motion. 

(iii) The fixed-gain I term 


At) = A0) + 71 KO + 72 f At)dt 
J o 

( 22 ) 

Kp(t) = Kp{ 0 ) + aj r(t)e'(t) + ai 

j 

f rit)e'(t)dt 
f 0 

( 23 ) 35 

KM = KA 0) + fiiroyd) + 02 J 

r t ^ 

1 r(t)e'U)dt 
n 

( 24 ) 


It is noted that the choice of {W^Wy} affects all adapta- 
tion rates in (22)— (24) simultaneously; whereas the adap- 
tation rate for each term (f(t),K^(t),Ky(t)} can be af- 
fected individually by the selection of {7 /, a/,/3/} inde- 45 
pendently. The proportional terms in the adaptation 
laws (22)-(24) act to increase the rate of convergence of 
the tracking-error e(t) to zero. The use of P + I adapta- 
tion laws also yields increased flexibility in the design, 
in accordance with the features of the invention, by 50 
providing a larger family of adaptation schemes than 
obtained by the conventional I adaptation laws. 

The physical interpretation of the auxiliary signal is 
obtained by substituting from (21) into (22) to yield ^ 

, ( 25 ) 

At) = A0) + 71 WpAt) + Wvkt)] + 72 f Wpeit) + 

J o 

w&0]dt 60 

= A0) + [71 Wp + 72 WM0 + [72 f * eit)dt + 

J o 

[y\W v )kt) 

Hence, f(t) can be generated by a PID controller with 65 
fixed gains acting on the tracking-error e(t). Thus, the 
feedback controller (17) can be represented by the PID 
control law 



takes care of the fine motion in the steady-state, while 
the changes of 0(t) and 0(t) are small and the manipula- 
tor model is approximately linear. Thus the I term con- 
tributes during the final phase of motion. 

3.3 Total Control System of the Invention 

The total control system is obtained by combining the 
nominal feedforward controller 220 operating in accor- 
dance with equation (16) and* the adaptive feedback 
controller 250 operating in accordance with equation 
(17) as shown in FIG. 2 to yield the control law 

m = v 0 u) + v a (t) (:8) 

= r)& r + N 0 (mo,@ r>& r)] + [At) + 

Kp(t)e(t) + Ky(t)e(t)) 

where V is the total voltage applied at the actuators. It 
is important to note that in this control configuration, 
closed-loop stability is not affected by the feedforward 
controller. 

I shall now discuss two extreme cases: 

Case i: UNKNOWN MANIPULATOR MODEL 

When no a priori information is available on the ma- 
nipulator dynamic model, that is M o =N o =0, the feed- 
forward controller has no contribution, i.e. v o (t)=0. In 
this case, the control system approach reduces to the 
adaptive feedback control law 

m -At) + Kp(t)e(t) + KMe{0 ( 29 ) 


which can be implemented with a high sampling rate. 
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Case ii: FULL MANIPULATOR MODEL 

When the full dynamic model and accurate parameter 
values of the manipulator, actuators and payload are 
available for on-line control, that is M 0 = M and N 0 — N, 5 
the feedforward controller can generate the required 
actuator voltage V 0 (t). In this case, the adaptation pro- 
cess can be switched off and the feedback controller 
reduces to a fixed-gain PD controller (K^OXV^O)}. 
The control law is now given by 10 

6 r )8r+ N(m, dj r ) + +*v(P&i) (30) 

which is the feedforward version of the Computed 
Torque Technique. See, for example, P. K. Khosla and 15 
T. Kanade: Experimental Evaluation of Nonlinear Feed- 
back and Feedforward Control Schemes For Manipula- 
tors, Intern. Journ. of Robotics Research, Vol. 7, No. 1, 
pp. 18-28, 1988. 

I have concluded that there is a trade-off between the 20 
availability of a full dynamic model and the controller 
adaptation process. In the range of possible operation, 
one can go from one extreme of no model knowledge 
and fully adaptive controller, to the other extreme of 
full model knowledge and non-adaptive controller. 25 

4. Digital Control Algorithm 

In Section 3, it is assumed that the control action is 
generated and applied to the manipulator in continuous 
time. In practical implementations, however, manipula- 30 
tors are controlled by means of digital computers in 
discrete time. In other words, the computer receives the 
measured data (joint positions 6) and transmits the con- 
trol signal (actuator voltages V) ever T s seconds, where 
T s is the sampling period. It is therefore necessary to 35 
reformulate the manipulator control problem in discrete 
time from the outset. In practice, however, the sampling 
period T s is often sufficiently small to allow us to treat 
the manipulator as a continuous system and discretize 
the continuous control law to obtain a digital control 40 
algorithm. This approach is feasible for the invention, 
since the on-line computations involved for real-time 
control are very small; allowing high rate sampling to 
be implemented. 

In order to discretize the control law, let us consider 45 
the adaptation laws (1 8)— (20) for the feedback control- 
ler and integrate them in the time interval 
t(N — 1)T 5 ,NT 5 ] to obtain 

m = AN - 1) + yi[m - *A- 1)] + 50 

72 ■ -7- im + riN - 1)] 

K p (N) = K p {N - 1) + ai[*A>TV) - *A' - 1 )e\N - 1)] + 

55 

a 2 • -7- [KAV0V) + r{N - \)e'{N - 1)] 

Km - K,{N - 1) + jSiMWW - *N - 1 )'e'(N - 1)] 4- 

' T s 60 

$2 ■ — [*A>'(A) + *A - l)e'(N - 1)] 

where N and N — 1 denote the sample instants and refer 
to t = NT 5 and t=(N-l)T* e(N) = OfN) — 0(N) is the 
discrete position error, and the integrals are evaluated 65 
by the trapezoidal rule. The discrete adaptation laws 
can be written as 


*V)= Wpe{X)+ IVMX) 


AW - yi-V - 1) + \72 * - 7 “ - 71 *A - 1 ) + 


T s 1 

72 * “3” + 71 JrW 

r T 1 (33) 

K p (N) = K p {N - 1) + \a 2 • - 7 - - aj J/(-V - l)e'(N - 1) + 

j^ a 2 • -J- + a, J^.W(.V) 

r (34) 

K V (N) = K/N - 1) + I 02 ■ -T- - /3| Uv - 1 )e'(.\ - 1) + 

[ft- -7- + J81 

In the above equations, we have assumed that the dis- 
crete velocity error e(N) is directly available using a 
tachometer; otherwise the velocity error must be 
formed in software as 

*.v> = . 

Equations (3 1)— (34) consititute the recursive algorithm 
for updating the feed-back controller. 

- Let us now evaluate the number of on-line mathemat- 
ical operations that need to be performed in each sam- 
pling period T 5 to form the discrete feedback control 
law 

V a (W=AW+fyWAW+KAWhW (35) 

where e(N) and e(N) are assumed to be available. For a 
centralized feedback controller, the total numbers of 
additions and multiplications in forming V a (N) are 
equal to 6n 2 + 3n and 6n 2 -f 8n, respectively, where n is 
the number of manipulator joints. For a decentralized 
feedback controller, the numbers of operations are re- 
duced to 9n additions and 14n multiplications. The 
small number of mathematical operations, particularly 
in the decentralized case, suggests that we can imple- 
ment a digital servo loop with a high sampling rate, i.e. 
very small T s . This is a very important feature in digital 
control since slow sampling rates degrade the tracking 
performance of the manipulator, and may even lead to 
closed-loop instability. 

Let us now turn to the discrete feedforward control 
law 

K o (AO = ^ o [m^0XAX^A7+A o [m (> ,JxA ? )} (36) 

where 0XN) and OfN) are directly available from the 
trajectory generator. Since the feedforward controller 
is “outside” the servo loop, it is possible to have a fast 
servo loop around the feedback controller, and the 
feedforward voltage V 0 (N) is then added at a slower 
rate. Furthermore, the feedforward control action 
V 0 (N) is computed as a function of the reference trajec- 
tory OfN) only. In applications where the desired path 
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Ori 0 is known in advance, the values of the voltage 
Vtf(N) can be computed “off-line” before motion begins 
and stored in a look-up table in the computer memory. 

At run time, this precomputed voltage history is then 
simply read out of the look-up table and used in the 
control law. Such an approach can be quite inexpensive 
computationally at run time, while allowing implemen- 
tation of a high servo rate for feedback control. 

The total control law in discrete time is given by 

y(N) = y 0 <N) + v a (.V) (37) 

= MoMAWem + rtJLmMNlOAWl + 

JW + K^NHN) + KAN)kN) 

Equations (3 1)— (37) constitute the digital control algo- 
rithm that is implemented for on-line computer control 
of robotic manipulators. 

5. Robust Adaptive Control 

The adaptation laws for the feedback controller as 
described in Section 3 are derived under the ideal condi- 
tions where unmodeled dynamics is not present and 
disturbances do not affect the system. In such idealistic 
conditions, the rate of change of a typical feedback gain 
K(t) which acts on the signal s(t) is found to be that set 
forth below in equation number (38). In expressing this 
relationship the auxiliary signal f(t), is developed by 
setting s(t)=l. 

k{t) - mi -jf + MKM 03 (38) 

where p\ and \xi are scalar adaptation gains. Extensive 
simulation and experimental studies suggest that too 
low adaptation gains result in smooth variations in K(t), 
but poor tracking performance. On the other hand, too 
high adaptation gains lead to oscillatory and noisy be- 
havior of K(t), but yield perfect trajectory tracking. 
(Note that for both low and high adaptation gains, the 
range of control voltage is more or less than the same, 
since it is primarily dependent on the reference trajec- 
tory and manipulators dynamics). This argument sug- 
gests that large adaptations gains are necessary to main- 
tain a high speed of controller adaptation in order to 
ensure rapid convergence of the tracking-error e(t) to 
zero. In practice, the adaptation gains cannot be se- 
lected too large due to a phenomenon known as “fast 
adaptation instability.” When the speed of adaptation, 50 
i.e. K(t), is too high, the gain K(t) drifts to large values 
and excites the unmodeled dynamics (parasitic) of the 
system, which in turn leads to instability of the control 
system. High speed of adaptation can be either due to 
large adaptation gains or fast reference trajectory. An- 55 
other mechanism for instability can be observed in de- 
centralized adaptive control systems. The interconnec- 
tions among subsystems can cause local controller pa- 
rameters to drift to large values and hence excite the 
parasitic and lead to instability. For instance, a high 60 
amplitude or high frequency reference trajectory of one 
subsystem can destabilize the local adaptive controller 
of another subsystem by exciting its parasitic through 
the interconnections. 

We conclude that in an adaptive robot control sys- 65 
tern, unstable behavior can be observed with large adap- 
tation rates or a high degree of interjoint couplings. It is 
unfortunate that in trying to compensate for the change . 
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in the system, the adaptive controller may become sen- 
sitive to its own parameters. 

I shall now discuss two possible approaches for 
avoiding the fast adaptation instability: 

5.1 Time-Varying Adaptation Gains 

From equation (38), it is seen that the speed of adapta- 
tion K(t) depends on the magnitude of the adaptation 
gains (/xi,ju,2) and on the weighted tracking-error r(t). 
1° Simulation studies with constant adaptation gain algo- 
rithms suggest that high gains lead to faster conver- 
gence of the tracking-error to zero. However, in the 
initial phase of adaptation, the weighted tracking-error 
r(t) is large (e.g. due to static friction) and too high a 
15 value of adaptation gain causes instability problems. As 
the adaptation process goes on, the term r(t) decreases 
and at this time the adaptation'gain is increased in order 
to achieve faster convergence. With this motivation, the 
constant adaptation gains /xi(t) and jui2(t) start with small 
20 initial values when the errors are usually large and, as 
time proceeds, build up to appropriate large final values 
when the errors are small. 

5.2 Robustness VIA cr-Modification 
25 

The P-f-I adaptation laws discussed so far have no 
provision for rejecting the destabilizing effect of 
“noise” introduced through unmodeled dynamics or 
disturbances. The integral term in the adaptation law 
acts to integrate a quantity related to the noise term 
squared. The integration of such a non-negative quan- 
tity inevitably creates an undesirable drift in the integral 
term and ultimately deteriorates the adaptive system 
performance. 

Ioannou and Kokotovic {Instability Analysis and Im- 
provement of Robustness of Adaptive Control, Au- 
tomatica, Vol. 20, No. 5, pp. 583-594, 1984; Robust 
Redesign of Adaptive Control IEEE Trans. Aut. Con- 
trol, Vol. AC-29, No. 3, pp. 202-211, 1984) suggest 
40 “cr-modification” to the adaptation law in order to 
eliminate the drift in the integral term and thus counter- 
act instability. The basic idea is to modify the adaptation 
law (38) by adding a term — crK(t) which removes its 
purely integral action, that is, instead of (38) we use the 
45 cr-modified law 

hi) = -O-K(t) + M 1 4. + M2 [KfK(0] (39) 

where cr is a positive scalar design parameter. The size 
of cr reflects our lack of knowledge about the unmod- 
eled dynamics and disturbances. In equation (39), the 
leakage or decay term — crK(t) acts to dissipate the 
integral buildup, and eliminate the drift problem which 
excites the parasitic and leads to instability. The price 
paid for the attained robustness is that the tracking- 
error 1 1 r(t) 1 1 no\y converges to a bonded non-zero 
residual set, and hence perfect trajectory tracking is no. 
longer achieved in theory. The size of this residual set 
depends .on the value of cr, but can often be made suffi- 
ciently small so that performance degradation is accept- 
able in practice. The drawback of the cr-modified adap- 
tation law, however, is that in the absence of unmodeled 
dynamics and disturbances, we can no longer guarantee 
that limbec || r(t) || =0, unless cr— 0. 

The Proportional + Integral 4- Sigma (P + 1 + cr) adap- 
tation laws for the feedback controller in continuous 
time are now given by 
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C t ft (40) 

yw = AO) + y\ lit) + 72 liOdt - cr\ Jll)dt 
J 0 J 0 

r i (40 5 

K p (t) = K p (0) 4 a\rit)e’(t) 4 a 2 r{t)e\t)di - 
J 0 


0*2 f K p {t)dt 
J 0 

r ' . ( 42 > 

Ky(t) = KA 0) + 4 02 *t)e\t)dt - 

J 0 


C ' 15 

o*3 

J 0 


6. Simulation Results 

The tracking control scheme developed in Section 3 
has been applied to a two-link manipulator for illustra- 
tion of the benefits of the invention. 

Consider the planar two-link manipulator in a vertical 
plane shown in FIG. 3, with the end-effector carrying a 
payload of mass m. The robot links are assumed to be 
driven directly (without gears) by two servomotors 
with negligible dynamics. Hence the arm is “direct 
drive” and we can treat the joint torques as the driving 
signals. The dynamic equation of motion which relates 
the joint torque vector 

-GO 


10 


where {crua 2 ,cr}} are positive scalar design parame- 
ters. For digital control implementation with sampling t0 -i 0 * nt an ^ e vector 
period T 5 , (40)-(42) yield the recursive adaptation laws 2 
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In conclusion, the use of cr-modification is essential in 
obtaining sufficient conditions for boundedness in the 
presence of parasitic. However, in the absence of para- 
sitic, cr causes a tracking-errOr of O(Vcr) to remain. 
Therefore, there is a trade-off between boundedness of 
all signals in the presence of parasitic and loss of exact 
convergence of the tracking-error to zero in the absence 
of parasitic. In other words, we have sacrificed the 
performance in an idealistic situation in order to achieve 
robustness in realistic situations which are more likely 
to occur in practical applications. 
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is given by H. Seraji, A New Approach to Adaptive Con- 
trol of Manipulators , supra, and H. Seraji, M. Jamshidi, 
Y. T. Kin, and M. Shahinpoor, Linear Multivariable 
Control of Two-Link Robots, Journal of Robotic Sys- 
tems, Vol. 3, No. 4, pp. 349 >365, 1986. 

T 

= \{(djd+N(e,6 )+G(0) + i/(0) + m/(0)[J(6O0+- 
Ad,6)9+g] (46) 


40 


45 


50 


where the above terms are: 



/ \ 
ai 

a\ 4 a 2 cos 02 a 2 4 — ^ — cos 02 


( . . . 

— (a*>sin 02 )( 0]02 4 — x — 

M(6) = 

a.2 

03 + — •= — COS02 03 
\ ) 

; A r (0.0) = 

it 

(a*>sin 0 ->) — r — 

\ " ' 2 / 


G{B) ■ 


f ct4COS0i 4- a5Cos(0i 4- 02) ^ • f V\d\ 4- V 2 sgn{6\) \ 

~ \ a 5 cos(0i 4- 02) / ~ \ V 302 4 Ktffffl<&2) J 


-lisin0i — bsin(0i 4 02) — bsin(0i -1- 02) 

J{6) = 1 “ I; g 

llCOS0l 4- l2 c °s(0l 4 02) 12COS(01 4 02) 


(+9.81 ) 



5,049,796 


19 

In the above expressions, ai, . . . , as are constant param- 
eters obtained from the masses (m 1 , 1112 ) and the lengths 
(Ii,l 2 ) of the robot links, and (Vi,V 3 > and (V 2 ,V 4 ) are 
coefficients of viscous and Coloumb frictions respec- 
tively. For the particular robot under study, the numeri- 
cal values of the link parameters are mi = 15.91 Kg; 
1112 = 11.36 Kg; lj =12=0.432 m so that they represent 
links 2 and 3 of the Unimation PUMA 560 robot. This 
yields the following numerical values for the model 
parameters (H. Seraji, M. Jamshidi, Y. T. Kim, and M. 
Shaninpoor, supra) 

ai = 3.82; a 2 =2.12; a3=0.71 a 4 =81.82; as = 24.06 
The friction coefficients are chosen as Vi=^V 3 = 1.0 
Nt.nvTad.sec ~ 1 and V 2 = V 4 = 0.5 NT.m and the pay- 
load mass is initially m= 10.0 Kg. 

The joint angles 0j(t) and 02(0 are required to track 
the cycloidal reference trajectories 
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where M and G are defined in (46). It is seen that each 
tracking control law is composed of feedforward and 
feedback components. The feedforward component has 
a centralized structure and is based on the manipulator 
5 dynamic model (46). It is a function of the reference 
trajectory t) and contains the inertial acceleration 
term M(0 r )0 r and the gravity loading term G(0 r ) of the 
arm itself, without the payload (i.e., m=0). The Coriojis 
and centrifugal term N(0,0), the frictional term H(0), 
10 and the payload term are assumed to be unavailable for 
on-line control and are not incorporated in the feedfor- 
ward controller. The feedback controller has a decen- 
tralized structure and is composed of the auxiliary sig- 
nal f(t), the position feedback term k p (t)e(t), and the 
15 velocity feedback term k v (t)e(t) where e(t)=dr(t)~0(t) 
is the position tracking-error in radians. The feedback 
terms are updated, as (In this example, the cr-modifica- 
tion was not necessary, and hence cri = <r 2 = 0 * 3 = 0 ). 
And it may be shown that: 


AU) =/l(0) + y\ r\(0 + 721 f r\(t)dt - cry] f f\U)dt = f 
Jo J Q J 0 


r\(t)dt 


(49) 


kpiit) - k pi { 0 ) + a\ inWefa) 4 - a 2 i f* r,{i)e t {t)dt - cr 2 i I k pi 1 

J 0 • J 0 

>r '» 

J o 


(50) 


= r,it)e,{t) -h 10 r,{t)ej(t)dt 
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M0) + PuniOlit) + fa mociiodt - 

Jo 



niOe/ii) + 10 



r t {t)e t \t)dt 


(50 


0,1(0 = - T + T [‘T £_ - 0 = ' = 3 

= 0 3 < / 

QrlU) = -J- |^“T^ sin J 0 ^ t £ 3 


so that the robot configuration changes smoothly from 
the initial posture 

(<>, = -f-,02 = ° ) 

to the final posture 

( 0, = 0, 02 = + Y ) 

in three seconds. The joint angles are controlled by the 
feedforward and/or feedback tracking control scheme 

T\(t)=[Mu(Q r )er\+Mn(6 r )h r2 

72(0 = [M 2 1 (e r )Brl + M 2 2(e r )0r2 + G 2 (0r)] + + *- 

p 2 U)e 2 (t)+k y2 (t)e 2 (t)) (48) 


r,{t ) « wpidt) + w vt e,ir) = 3000e,V) + 1 500&0 (52) 

40 Note that the initial values of the auxiliary signal and 
the feedback gains are all chosen arbitrarily as zero. 
(The numerical values of w^ and w v in (52) are large 
since the unit of angle in the control program is “ra- 
dian.” A simple trapezoidal integration rule is used to 
45 compute the integrals in the adaptation laws (49)— (51) 
with dt=l millisecond. 

To evaluate the performance of the proposed control 
scheme, the nonlinear dynamic model of the manipula- 
tor-plus-payload (46) and the tracking control scheme 
50 (48) are simulated on a DEC-VAX 11/750 with the 
sampling period of 1 millisecond. In order to illustrate 
the effectiveness of the proposed control scheme to 
compensate for sudden gross variation in the payload 
mass, the mass is suddenly decreased from m=10.0 Kg 
55 to zero at 6=1.5 seconds (i.e. the payload is dropped) 
while the manipulator is in motion under the control 
system operating in accordance with equation (48). The 
results of the computer simulation are shown in FIG. 
4(/)-(/7) and indicate that the joint angles 0j(t) and 07(t) 
60 track their corresponding reference trajectories it is also 
shown that 6 r i(t) and 0 r 2 (t) vary closely throughout the 
motion, despite the sudden payload variation. FIGS, 
5(0-00 a *td 6(/)-(/7) show the responses of the tracking- 
errors ei(t) and e 2 (t) and the control torques T i(t) and 
65 T 2 (t), and indicate a sudden jump at t = 1.5" due to 
payload change. To show the feedback adaptation pro- 
cess, time variations of the auxiliary signal F}(t), the 
position gain k^/t), and the velocity gain k V 7 (t) are 
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shown in FIGS. 7(f)-(iii). It is seen that the feedback 
terms have adapted rapidly on-line to cope with the 
sudden payload mass change. The results demonstrate 
that the invention does not require knowledge of the 
payload mass m and can adapt itself rapidly to cope 5 
with unpredictable gross variations in m and sustain a 
good tracking performance. 

7. Experimental Results 

In this section, the tracking control system described 10 
in Section 3.2 is applied to a PUMA industrial robot for 
test and evaluation purposes. 

The testbed facility at the JPL Robotics Research 
Laboratory consists of a Unimation PUMA 560 robot 
and controller, and a DEC Micro VAX II computer, as 15 
shown in the functional diagram of FIG. 8. The Mi- 
croVAX II hosts the RCC1 (Robot Control “C” Li- 
brary) software, which was originally developed at 
Purdue University (V. Hayward and R. Paul, Introduc- 
tion to RCCL: A Robot Control ‘C Library, IEEE In- 20 
tern. Conf. on Robotics, pp. 293-297, Atlanta, 1984, and 
subsequently modified and implemented at JPL. During 
the operation of the arm, a hardware clock constantly 
interrupts the I/O program resident in the Unimation 
controller at a preselected sampling period T s , which 25 
can be chosen as 7, 14, 28 or 54 milliseconds. At every 
interrupt, the I/O program gathers information about 
the state of the arm (such as joint encoder readings), and 
interrupts the control program in the Micro VAX II to 
transmit this data. The I/O program then waits for the 30 
control program to issue a new set of control signals, 
and then dispatches these signals to the appropriate 
joint motors. Therefore, the MICROVAX II acts as a 
digital controller for the PUMA arm and the Unimation 
controller is effectively by-passed and is utilized merely 35 
as an I/O device to interface the Micro VAX II to the 
joint motors. 

To test and evaluate the control system described in 
Section 3, the tracking controller is implemented on the 
waist joint Q\ of the PUMA arm, while the other joints 40 
are held steady using the Unimation controller. The 
waist control law is coded within the RCCL environ- 
ment on the Micro VAX II computer. It is assumed that 
the dynamic model and parameter values of the arm are 
not available, and hence the feedforward controller is 45 
eliminated. The control torque for the waist joint at 
each sampling instant N is obtained from the adaptive 
PID feedback control law 

n.V ) =m + k p (X)ciN) + (53) 50 
where e(N)=0 r \(N) — 9 1 (N) is the waist position error, 


fry) - - g- v - . 9. 

ts 

is the waist velocity error formed in the software, and 
0ri(t) is the reference trajectory for the waist joint. The 
feedback terms are generated by the following simple 60 
recursive adaptation laws (In the experiment, it was not 
necessary to use cr-modification and hence we set 
cr —0). 

r(X)=30e(N)+20e(N) (54) 65 

AR)—/{N~ 1)4-0.175 [/(AO-MAT- 1)] (55) 
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l) + O.35KA>0V)+*V- 1)<K.V- • 1)] (56) 

*vGV) = A'vGV- l) + 2.8KAVcV)-b/GV- 1M.V— i)] (57) 

where the adaptation gains are found after a few trial- 
and-errors. The sampling period is chosen as the small- 
est possible value T 5 =7 milliseconds (i.e. sampling 
f?= 144 H 2 ), since the on-line computations involved in 
the control law (53) are a few simple arithmetic opera- 
tions. No information about the PUMA dynamics is 
used for implementation of the control system, and 
hence the controller terms are initially zero; i.e. 
f(0) = k^O) = k v (0) = 0. 

The PUMA arm is initially at the “zero” position 
with the upper-arm horizontal and the forearm vertical 
forming a right-angle configuration. The waist joint 
angle 0\(t) is commanded to change from the initial 
position 0i=O to the goal position 

*'=f 

in 2 seconds. The reference trajectory 0 r i(t) is synthe- 
sized by the cycloidal trajectory generator in RCCL as 


6 r \{t) — [?r/ — sinrr/j 0 ^ ^ 2 


While the arm is in motion, the reading of the waist 
joint encoder at each sampling instant is recorded di- 
rectly from the arm, converted into degrees and stored 
in a data file. The values of the auxiliary signal and 
feedback gains are also recorded at each sampling and 
kept in the same data file. FIG. 9(/j shows the desired 
and actual trajectories of the waist joint angle and the 
tracking-error is shown in FIG. 9(/7). It is seen that the 
joint angle 0i(t) tracks the reference trajectory 0 r i(t) 
very closely, and the peak value of the tracking-error 
e(t) is 1.40°. The initial lag in the d\ response is due to 
the large stiction (static friction) present in the waist 
joint. 

FIGS. 10(0-00 show the tracking performance of the 
waist joint for the same motion using the Unimation 
controller, which is operating with the sampling period 
of 1 millisecond f s = 1 KH 2 . It is seen that the peak joint 
tracking-error in FIG. 10(0) is 5.36°, which produces 4 
centimeters peak position error at the end-effector. By 
comparing FIGS. 9 (if) and 10(/7), it is evident that the 
tracking performance of the adaptive controller is no- 
ticeably superior to that of the Unimation controller, 
despite that fact that the Unimation control loop is 7 
times faster than the adaptive control loop. The varia- 
tions of the auxiliary signal f(t), the feedback gains k p (t) 
and ky/t), and the control torque T(t) are also shown in 
FIGS. ll(O-OV). It is seen that f(t), k^(t), k v (t), and T(t) 
all start from the initial values of zero and change with 
time. 

I shall now discuss a test relating to the tracking 
performance of the adaptive controller in a different 
situation. Suppose that the configuration of the arm is 
changed smoothly from the initial zero posture to the 
final vertical posture while the waist joint is in motion. 
This effectively imposes a dynamic inertial load on the 
waist motor, as well as introducing torque disturbances 
in the waist control loop due to inter-joint couplings. 
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We now specify a different desired trajectory for the 
waist angle whereby 0\ is commanded to change from 0 
to 


in three seconds while tracking a cycloidal trajectory. 
Using the same adaptive control law (53), the actual 
recording from the waist joint and the desired trajec- \q 
tory are shown in FIG. 12(0 an d the tracking-error is 
plotted in FIG. 12(u). It is seen that the actual trajectory 
tracks the new desired trajectory very closely, despite 
the dynamic loading on the waist joint and the inter- 
joint coupling disturbances. The experimental results 15 
demonstrate that the invention’s control system is not 
sensitive to the arm configuration, torque disturbances, 
or the desired trajectory. 

The following observations are made from further 
experiments on the PUMA robot: 2 o 

1. Using the Unimation controller, the tracking-error 
increases for fast motion under heavy payload. For 
instance, when the arm is fully extended horizontally 
carrying a five pound payload and the waist joint is 
moved by 90° in 1.2 seconds, the peak joint tracking- ?5 
error is about 9°. When transformed to the end-effector, 
this gives the peak tip error of 16 centimeters. 

2. The rate of sampling, T s > has a central role in the 
performance of the proposed control scheme. In the 
adaptive feedback controller, the sampling rate' deter- 
mines the rate at which the feedback' gains and the 30 
auxiliary signal are updated. Faster sampling rate 
(smaller T 5 ) allows higher adaptation rates to be used, 
which in turn leads to a better tracking performance. 
When the sampling rate is slow (large T 5 ), the tracking 
performance is degraded, and the use of high adaptation 35 
gains may lead to closed-loop instability. For instance, 
for T 5 = 14 msec, the adaptation gains equations 
(54)— (57) must be reduced to maintain stability, and this 
degrades the tracking performance. In general, when 

T s is large, the effects of sampling and discretization are 40 
more pronounced and the control system performance 
is degraded. Therefore, in practical implementation, it is 
highly desirable to increase the sampling rate as much 
as possible by optimizing the real-time control program 
or using a multi-processor concurrent computing sys- 45 
tern. In the present experimental setup, for any sampling 
period T s , about three msec is taken up by the communi- 
cation between the Micro VAX II and the Unimation 
controller; hence for T^~7 msec only four msec is 
available for control law computations. 50 

3. The feedback adaptation gains in (54)-(57) should 
not be chosen unnecessarily high, since too high gains 
can lead to instability while producing negligible im- 
provement in the tracking performance (e.g., an accept* 
able peak error of 1° may decrease to 0.1°). For in- 55 
stance, for the adaptation gains given in the above ex- 
periment, motion of 6\ by 90° in 1.2 seconds leads to 
instability. In this case, it is necessary to decrease the 
adaptation gains or to introduce ^-modification in 
order to ensure stability. Therefore, in general, the ad- 60 
aptation gains must be chosen to yield an acceptable 
tracking performance for the fastest trajectory in the 
experiment, i.e. “the worst case design”. 

4. For very slow motions of the waist joint (e.g., 
average speed of 2Vsec), the friction present in the 65 
waist joint has a dominating effect and therefore the 
implemented control scheme has a poor performance. 
This is due to the fact that in this case, the control 
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torque T c is comparable in magnitude to the stiction T 5 
of the joint, and hence the net torque T c — T 5 applied to 
the joint is not sufficiently large. Therefore, for slow 
motions, it is necessary to introduce a feedforward con- 
troller or a friction compensation in order to counteract 
the effect of stiction. The situation is improved by in- 
creasing the sampling rate. 

8. Conclusions 

A new and simple robust control system for accurate 
trajectory tracking of robotic manipulators has been 
described. The control system takes full advantage or 
any known part of the manipulator dynamics in the 
feedforward controller. The adaptive feedback control- 
ler then compensates for any unknown dynamics and 
uncertainties/variations in the manipulator/payload 
parameters. 

From the tracking point of view, it is desirable to set 
the feedback adaptation rates as high as possible so that 
the feedback controller can respond rapidly to varia- 
tions in the manipulator dynamics or sudden changes in 
the payload. High rate adaptation, however, can cause 
instability through the excitation of unmodeled dynam- 
ics. The. stability is counteracted by the addition of 
decay terms to the integral adaptation laws to yield an 
adaptive controller which is robust in the presence of 
unmodeled dynamics and disturbances. 

The feedback adaptation laws in Section 3 are de- 
rived under the assumption that the robot model is 
“slowly time-varying” in comparison with the control- 
ler terms. In theory, this assumption is necessary in 
■ order to derive simple adaptation laws which do not 
contain any terms from the robot model. In practice, the 
simulation and experimental studies of Sections 5 and 6 
justify the assumption, even under gross abrupt change 
in the payload. This is due to the robust nature of adapt- 
ive control schemes, which is discussed briefly in H. 
Seraji, A New Approach To Adaptive Control of Manipu- 
lators, supra. Nevertheless, further simulations and ex- 
periments need to be performed using direct-drive arms 
in fast motions to test the practical limitations of the 
simplifying assumption of slow time variation. 

Simulation results for a two-link robot and experi- 
mental results of a PUMA industrial robot validate the 
capability of the invention’s control system in accurate 
trajectory tracking with partial or no information on the 
manipulator dynamics. 

Finally, the control features presented herein can 
readily be extended to the direct control of end-effector 
position and orientation in Cartesian space. In this for- 
mulation, the controllers operate on Cartesian variables 
and the end-effector control forces are then trans- 
formed to joint torques using the Jacobean matrix (H. 
Seraji, An Approach To Multivariable Control Of Manip- 
ulators, ASME Journ. Dynamic Systems, Measurement 
and Control, VoL 109, No. 2, pp. 146-154, 1987 and H. 
Seraji, Direct Adaptive Control Of Manipulators In Carte- 
sian Space, Journal of Robotic Systems, Vol. 4, No. 1, 
pp. 157-178, 1987. 

The above description presents the best mode con- 
templated in carrying out my invention. My invention 
is, however, susceptible to modifications and alternate 
constructions from the embodiments shown in the 
drawings and described above. Consequently, it is not 
the intention to limit the invention to the particular 
embodiments disclosed. On the contrary, the invention 
is intended and shall cover all modifications, sizes and 
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alternate constructions falling within the spirit and 
scope of the invention, as expressed in the appended 
claims when read in light of the description and draw- 
ing. 

What is claimed is: 5 

1. A robotic system that combines model-based and 

performance-based techniques to control a manipulator 
by a control signal developed in response to input com- 
mand terms and formed from nominal and complement 
control-signal components, said system comprising; 10 

a distinct feedforward circuit means, model-based 
and containing user-accessible inputs for receiving 
a priori information concerning the manipulator’s 
dynamics, as input into said feedforward circuit 
means by an operator of said system, said feedfor- 15 
ward circuit means for controlling said manipula- 
tor by a nominal signal component delivered by the 
feedforward circuit means to said manipulator; 

a second feedback circuit means, distinct and separate 
forms aid feedforward means, performance-based 20 
and responding adaptively to actual performance 
of said controlled manipulator, for emitting a feed- 
back-related signal complement; and 

signal combining means- connected to said feedfor- 
ward and feedback means for combining said feed- 25 
back-related signal complement with said nominal 
signal component from said distinct feedforward 
circuit means in order to form a combined control 
signal, which combined control signal fully con- 
trols said manipulator’s performance. 30 

2. A robotic system in accordance with claim 1 
wherein desired manipulator position, velocity, and/or 
acceleration are individual command input terms for 

. the system, and said distinct feedforward circuit means 
is model-based and contains any known part of the 35 
manipulator’s dynamics that can be used for on-line 
control, and said feedforward circuit means further 
includes; 

computation elements that receive said priori infor- 
mation about the manipulators dynamics as input 40 
by the operator and responds to such information 
and to the desired command input terms for com- 
puting partial information for on line control over 
said manipulator by said nominal signal as devel- 
oped by said feedforward means. 45 

3. A robotic system that combines model-based and 
performance-based techniques to control a manipulator 
by a control signal developed in response to input com- 
mand terms including desired manipulator position, 
velocity, and/or acceleration as individual command 50 
input terms for the system, and wherein said control 
signal is formed from nominal and complement control- 
signal components; said system comprising; 

feedforward circuit means, model-based and contain- 
ing a priori information concerning the manipula- 55 
tor’s dynamics, as input into said feedforward cir- 
cuit means by an operator of said system, for con- 
trolling said manipulator by a nominal signal com- 
ponent delivered by the feedforward circuit means 
to said manipulator; 60 

feedback circuit means, performance-based and re- 
sponding to actual performance of said controlled 
manipulator, for emitting a feedback related signal 
complement which combines with said nominal 
signal component from said feedforward circuit 65 
means in order to form a combined control signal, 
which combined control signal controls said ma- 
nipulator’s performance; 
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and said feedforward circuit means further includes; 
computation elements that receive said priori infor- 
mation about the manipulators dynamics as input 
by said operator and responds to such information 
and to the desired command input terms for com- 
puting partial information for on-line control over 
said manipulator by said nominal signal as devel- 
oped by said feedforward means; and 
an actuator for said manipulator, and wherein the 
manipulator-plus-actuator has a given configura- 
tion, speed of motion, and a payload mass which is 
expressed as integrated dynamic model defined as; 

M(m,0)0 + N(m,0,0)=V 

wherein the above-noted terms are defined as 

M(m,0)=G + E^l*(m,0); 

N(m,0,0)=C0-|-EN*(m ) 0,0) 

and m is the payload mass, M*(m,0) is the symmet- 
ric positive-definite nXn inertia matrix, N*(m,0,0) 
is the nxl vector representing the total torque due 
■ to Coriolis and centrifugal term, gravity loading 
term, and frictional term, and the elements of M* 
and N* are highly coalex nonlinear functions 
which depend upon the configuration 6 , the speed 
of motion 0 , and, G and C respectively, are the 
inertia term and damping term for the payload 
mass m of said manipulator-plus-actuator. 

4 . A control system in accordance with claim 3 
wherein said manipulator has control joints and said 
system has an adaptation control law, and is further 
characterized in that; 

said adaptation control law is decentralized with 
variable gains (K p (t),K v (t)}, being defined as diag- 
onal matrices and the ith diagonal elements of said 
diagonal matrices being obtained from said adapta- 
■ tion law, with an error feedback voltage e(t) re- 
placed by e,{t), as follows: 

J(t)=y'r(t)+y2r(t) 


Kp(t) = aj 4- [Kf)e'(0] + cnMOe'W] 

KM = [*')«(')] + PMok')] 

wherein the prime denotes transposition, and r(t) is 
the nX 1 vector of “weighted” position-velocity 
error defined as r(t) = Wpe(t) + W v e(t), and {y/. 

are zero or positive proportional adaptation 
gains, are positive integral adaptation 

gains, and W^diag/fWp/) and. W^+diagi(W w -) are 
constant nXn matrices which contain the position 
and velocity weighting factors for all said control 
joints in the manipulator being controlled. 

. 5. A method of robotic control in which an on-line 
control over a manipulator has been initially established 
by a model-based control signal, the improvement com- 
prising the steps of 

complementing said model-based control signal with 
another signal developed by a feedback circuit 
means; 

developing error signals each indicating the differ- 
ence between the desired and actual manipulator 
velocity and position, with each error signal sub- 
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ject to an adaptation law which includes variable ‘ 
gain for each error signal in order to develop said 
complement signal component; and 
expressing said adaptation law as r(t) which is the 
nX 1 vector of “weighted” position-velocity error 5 
defined by: 

rit)=Wpp(t)+W&t) 


At) - AO) = yiWO - *0)] + 72 f At)dt 

J 0 

Kp{t) - K p ( 0) - ailfiOe'U) - *0K(0)] + a 2 f r{t)e\t)dt 

J 0 

r t 

K,{t) - ATv-CO) = - r{ 0)e'(0)] 4* fS 2 <t)e'(l)dt 

J 0 

and wherein {y\ 9 a\ t fi\} are zero or positive pro- 
portional adaptation gains, { 72 , 02 , P 2 } are positive 
integral adaptation gains, and W p — diag,{W p/ ) and 
W v =diag,<W v /) are constant nXn matrices which 
contain the position and velocity weighting factors 
for all joints of said manipulator. 

6. Formulating, in hardware, a control system appa- 
ratus which operates in accordance with the method 
steps of claim 5 and performing the further method 
steps of; 

integrating the equations of claim 5 in the time inter- 
val [0,], to obtain 

AO - AO) = yi WO - m] + 72 f *t)dt 

J 0 

Kp{t) - K p { 0) = ai[K/y(b - *0)e'm + a 2 f r{t)e\t)dt 

J 0 

K,{t) - KM = PdrU)e’(t) - MeM) + Pi f At)e'(t)dt 

J 0 

noting that the initial values of the reference and 
actual trajectories are the same, that is 

e(0) = e(0) = r(0) = 0, and 

establishing a Proportional + integral (P + I) adapta- 
tion law for improved control over said manipula- 
tor. 

7. The method of claim 6 and comprising the further 
steps of: 

affecting all adaptation rates simultaneously; and 
individually affecting the adaptation rate for each 
term (f(t),Kp(t),K v (t)} by selecting {y\,a\,fi]} in- 55 
dependently for improved control over said manip- 
ulator. 

8. The method of claim 7 comprising the further step 
of: 

increasing the rate of convergence of the tracking- 60 
error e(t) to zero. 

9. In a controller having a control signal which con- 
trols a manipulator’s position and velocity in Cartesean 
space, wherein the manipulator and environment form a 
system exhibiting nonlinear dynamics and system pa- 65 
rameters which may not be fully known to an operator 
and wherein the controller includes an adaptive feed- • 
back servo control loop which senses actual position 
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and velocity of said manipulator being controlled in 
Cartesian space, the improvement comprising: 

manipulator driving means responsive to said control 
signal for driving said manipulator in said environ- 
ment to achieve, in Cartesean space, a desired posi- 
tion, velocity, and acceleration as indicated by said 
control signal; 

a model-based feedforward loop outside of said 
adaptive servo control loop that allows the opera- 
1° tor to provide a nominal signal to the manipulator 
based upon a limited amount of knowledge con- 
cerning the manipulator and/or the system which 
the operator may elect to input into said system; 
and 

adaptive control means in said feedback servo control 
loop, responsive to said sensed position and veloc- 
ity, for varying said control signal applied to said 
manipulator’s driving means, which variable con- 
trol signal compensates in real-time for the system’s 
nonlinearities as said manipulator is driven in Car- 
tesean space to a controlled position and velocity. 

10. A control system in accordance with claim 9 and 
further wherein the system operates in real-time control 
with a given sampling rate, and said system further 
comprises; 

a feedforward computational element connected in 
said feedforward loop for receiving operator-input 
values concerning said manipulator and/or sys- 
tem’s dynamics in order to develop a nominal sig- 
nal that is applied to said control signal for said 
manipulator independently of said adaptive con- 
trolling means. 

11. In a controller having a control signal which 
35 controls a manipulator’s position and velocity in Car- 
tesean space, wherein the manipulator and its environ- 
ment form a system exhibiting nonlinear dynamics and 
system parameters which may not be fully known to an 
operator, and wherein the controller includes an adapt- 

4 q ive feedback servo control loop which senses actual 
position and velocity of said manipulator being con- 
trolled in Cartesian space, the improvement comprising: 
manipulator driving means responsive to said control 
signal for driving said manipulator in said environ- 
45 ment to achieve, in Cartesean space, a desired posi- 
tion, velocity, and acceleration as indicated by said 
control signal; 

a model-based feedforward loop separate and distinct 
from said adaptive servo control loop that allows 
50 the operator to provide a nominal signal to the 
manipulator based upon a limited amount of 
knowledge concerning the manipulator and/or the 
system which the operator may elect to input into 
said system; 

adaptive control means in said feedback servo control 
loop, responsive to said sensed position and veloc- 
ity, for varying said control signal applied to said 
manipulator’s driving means, which variable con- 
trol-signal compensates in real-time for the system’s 
nonlinearities as said manipulator is driven in Car- 
tesean space to a controlled position and velocity; 
and further wherein the system operates in real-time 
control with a given sampling rate, and said system 
further comprises; 

a feedforward computational element connected in 
said feedforward loop for receiving operator-input 
values concerning said manipulator and/or sys- 
tem’s dynamics in order to develop a nominal sig- 
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nal that is applied to said control signal for said 
manipulator independently of said adaptive con- 
trolling means in said separate and distinct feed- 
back control loop; and 

said adaptive control means operates in accordance 5 
with a control law which may be considered as 
though it was applied directly to the manipulator’s 
end effector in Cartesian space, and said controller 
further comprises: 

means connected in a force feedforward control loop 10 
for receiving a feedforward signal representing a 
desired mathematical term for said manipulator; 

an adaptive proportional-integral-differential (PID) 
controller in said feedback control loop; and 

a plurality of variable gain circuits for implementing 15 
a control law characterized as an adaptive feed- 
back controller described by 

Y a (0 =M + + KMKO 

20 

where V a (t) is the nXl adaptive control voltage 
vector, e(t)=0r(t)—d(t) is then nX 1 position track- 
ing-error vector, f(t) is an n X 1 auxiliary signal 
generated by the adaptation scheme, and 
{Kp(t),K v (t)} are nXn adjustable PD feedback gain 25 
matrices. 

12. A combined model-based and performance-based 

robotic control system that generates a combined con- 
trol signal developed from nominal and complement 
signal components, comprising; 30 

first distinct means, model-based and containing a 
priori information known by an operator concern- 
ing a manipulator’s dynamics, connected in a sepa- 
rate and distinct feedforward circuit for develop- 
ing said nominal signal component; and 35 

adaptive control means, also separate and distinct 
from said first means, performance-based and re- 
sponding adaptively to actual performance of said 
controlled manipulator, for combining said com- 
plement signal generated by said adaptive control 40 
means with said nominal signal as developed by 
said first means so that the combined signal ulti- 
mately has full control over said manipulator. 

13. A control system in accordance with claim 12 
which exhibits noise in the form of destabilization in the 45 
control system, which noise is compensated for by a 
cr-modified law, and wherein said system is further 
characterized in that: 

said noise is compensated for in the feedback means 
by said cr-modified control law that is expressed 50 
by: 


m = -crK(i) + fi, jp [Kr)s' ( 0] + «[*')*'(<)] 

55 

where cr is a positive scalar design parameter. 

14. A control system in accordance with claim 12 and 
further wherein the size of cr reflects a lack of knowl- 
edge about the unmodeled dynamics and disturbances 

of the manipulator system, and further wherein said 60 
system is characterized in that 

the leakage or decay term— crK(t) acts to dissipate an 
integral buildup, and to eliminate the drift problem 
which leads to instability, and ||r(t)|| converges 
to a bounded non-zero residual set. 65 

15. A control system in accordance with claim 12 in 
which said control system includes a Proportional In- 
tegral -f Sigma (P + I-f cr) adaptation law for said feed- 


30 

back controller, which law operates in continuous time, 
as given by: 


AO =A 0 ) + y\A 0 + 72 f 
J o 

AOdt - 0*1 J 

t 

AOdt 
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KM = 
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where {crj, cri,cr^} are positive scalar design pa- 
rameters. 

16. A control system in accordance with claim 13 and 
further characterized by a digital control implementa- 
tion with sampling period T s , which yields the recursive 
adaptation laws 


AM = 
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17. A combined model-based and performance-based 
robotic control system that generates a combined con- 
trol signal developed from nominal and complement 
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signal components and which exhibits noise in the form 
of destabilization in the control system, which noise is 
compensated for by cr-modified law, and wherein said 
system is characterized in that: 

means, model-based and containing a priori informa- 
tion known by an operator concerning a manipula- 
tor’s dynamic, connected in a feedback circuit for 
developing said nominal signal component; 
adaptive control means, performance-based and re- 
sponding adaptively to actual performance of said 
controlled manipulator, for combining said com- 
plement signal generated by said adaptive control 
means with said nominal signal so that ’the com- 
bined signal controls said manipulator; and 
noise compensating means in the feedback means 
including said cr-modified control law that is ex- 
pressed by: 

m = -o-m + h 3J- K'KM] + wM'KM] 


of the manipulator system, and further wherein said 
system is characterized in that 

a leakage or decay term — crK(t) acts to dissipate an 
integral buildup, and to eliminate the drift problem 
which leads to instability, and ||r(t)|| converges 
to a bounded non-zero residual set. 

19. A control system in accordance with claim 17 in 
which said control system includes a 

Proportional + Integral + Sigma(P + 1 + cr) adaptation 
law for said feedback controller, which law oper- 
ates in continuous time, as given by: 

AO = AO) + y\r(0 + 72 f f<0dt — o-j f At)di 

J o 


Kp{Q) + airir)e'(t) + a 2 f tit)e'(t)dt - cri f K p (t)dt 
J 0 J 0 


where cr is a positive scalar design parameter, jul 
and }i2 are scalar adaptation gains, r is the 
weighted tracking error, s' is the transportation of 25 
s, where s stands for the signal on which k is acting. 

18. A control system in accordance with claim 17 and 
further wherein the size of or reflects a lack of knowl- 
edge about the unmodeled dynamics and disturbances 


« r ^ • c ^ 

K,(0) -f P\ r(t)e'(t) 4 - £2 r{t)e'(t)dt - 0*3 K^t)dt 

Jo Jo 

where {cri,o- 2 ,cr 3 } dre positive scalar design pa- 
rameters. 

***** 
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